int init_servos()
{
  for(int i=0; i<N_HEAD; i++)
  {
    servo_head[i].attach(ns_head[i]);
  }

  for(int i=0; i<N_ARM; i++)
  {
    servo_left_arm[i].attach(ns_left_arm[i]);
    servo_right_arm[i].attach(ns_right_arm[i]);
  }

  for(int i=0; i<N_LEG; i++)
  {
    servo_left_leg[i].attach(ns_left_leg[i]);
    servo_right_leg[i].attach(ns_right_leg[i]);
  }
}

